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ABSTRACT 

This paper discusses the nonholonomic mechanical structure of space robots and its path planning. The 
angular momentum conservation works as a nonholonomic constraint while the linear momentum conservation 
is a holonomic one. Taking this in to account, a vehicle with a 6 d.o.f. manipulator is described as a 9 variable 
system with 6 inputs. This fact implies the possibility to control the vehicle orientation as well as the joint 
variables of the manipulator by actuating the joint variables only if the trajectory is carefully planned, although 
both of them cannot be controlled independently. It means that assuming feasible-path planning a system that 
consists of a vehicle and a 6 d.o.f. manipulator can be utilized as 9 d.o.f system. In this paper, first, the 
nonholonomic mechanical structure of space vehicle/manipulator system is shown. Second, a path planning 
scheme for nonholonomic systems is proposed using Lyapunov functions. 


1. INTRODUCTION 

The control of space vehicle/manipulator system possesses inherent issues that have not been considered 
for on-the-earth robot manipulators, such as the micro gravity, momentum conservation, and preciousness of 
energy. The kinematics and dynamics of space vehicle/manipulator systems have recently been studied by 
various researchers. 

Alexander and Cannon [1] assumed concurrent use of the thrust force of vehicle and the manipulator joint 
torque, and proposed a control scheme taking account of the effect of the thrust force in computing the joint 
torque of manipulator. Dobowsky and Vafa [2] and Vafa [3] proposed a novel concept to simplify the kinematics 
and dynamics of space vehicle/manipulator system. A virtual manipulator is an imaginary manipulator that 
has similar kinematic and dynamic structure to the real vehicle/manipulator system but fixed at the total center 
of mass of the system. By solving the motion of the virtual manipulator for the desired motion of endeffector, 
the motion of vehicle/manipulator system is obtained straightforwardly. On the other hand, Umetani and 
Yoshida [4] reported a method to continuously control the motion of endeffector without actively controlling 
the vehicle. The momentum conservations for linear and angular motion are explicitly represented and used 
as the constraint equations to eliminate dependent variables and obtain the generalized Jacobian matrix that 
relates the joint motion and the endeffector motion. Longman, Lindberg, and Zadd [5] also discussed the 
coupling of manipulator motion and vehicle motion. Miyazaki, Masutani, and Arimoto [6] discussed a sensor 
feedback scheme using the transposed generalized Jacobian matrix. 

Both of the linear and angular momentum conservations have been used to eliminate dependent variables[4] 
[6]. Although both of them are represented by equations of velocities, the linear one can be exhibited by the 
motion of the center of mass of the total system, which is represented by the equations of positions not of 
velocities. This implies that the linear momentum conservation is integrable and hence a holonomic constraint. 
On the other hand, the angular momentum conservation cannot be represented by an integrated form, which 
means that it is a nonholonomic constraint. 

Suppose an n d.o.f. manipulator on a vehicle, the motion of the endeffector is described by n+6 variables, n 
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of the manipulator and 6 of the vehicle. By eliminating holonomic constraint of linear momentum conservation, 
the total system is formulated as a nonholonomic system of n+3 variables including 3 dependent variables. 
Although only n variables out of n-f3 can be independently controlled, with an appropriate path planning 
scheme it would possible to converge all of n+3 variables to a desired values due to the nonholonomic mechanical 
structure. A similar situation is experienced in our daily life. Although an automobile has two independent 
variables to control, that is, wheel rotation and steering, it can be parked at an arbitrary place with an arbitrary 
orientation in two dimensional space. This can be done because it is a nonholonomic system. 


To locate the manipulator endeffector at a desired point with a desired orientation, even a vehicle with a 
6 d.o.f. manipulator has redundancy because a variety of vehicle orientation can be chosen at the final time. 
This kind of nonholonomic redundancy would be utilized (1) when the extended Jacobian control results in an 
infeasible motion due to the physical joint limitation, (2) when the system requires more degrees of freedom 
to avoid obstacles at the final location of the endeffector, (3) when the vehicle orientation needs to be changed 
without using propulsion or a momentum gyro, and so on. 


In this paper, we propose a path planning scheme to control both of the vehicle orientation and the 
manipulator joints by actuating manipulator joints only. First, the nonholonomic mechanical structure of 
space vehicle/manipulator system is shown. Second, a path planning scheme for nonholonomic systems is 
proposed using Lyapunov functions. Since the planning scheme is given in a general form, it can be applied to 
other many nonholonomic planning problems, such as the path planning of 2 d.o.f. vehicles for 3 d.o.f. motion 
in a plane, planning of contact point motion of multifingered hands with spherical rolling contacts, and so on. 

2. ANGULAR MOMENTUM CONSERVATION AS 
NONHOLONOMIC CONSTRAINT 


2.1 Nomenclature 


frame I 
frame V 
frame B 
frame E 
frame I\ 


m k 

T r k E R 3 
B r k £ R 3 
6 R 3 

k I k e R 3x3 
I I k £ R 3x3 

0 1 € R 6 

02 E R n 
l A B e R 3x3 
1 A k £ R 3x3 

J* £ R 3xn 

Ei £ R ixi 

0,^,7 


Inertia frame. 

Vehicle frame. 

Manipulator base frame 
Manipulator endeffector frame 

k-th body frame, k- th link frame of manipulator for k = 1, * , n. n-th link frame 

is identical to the manipulator endeffector frame. Vehicle frame for k = 0. 

Mass of the k-th body (kg). 0-th body is the vehicle, k- th body (k > 1) is the k- th link of 
the manipulator. 

Position vector from the origin of the inertia frame to the center of mass of ib-th body 
represented in theinertia frame, (m) 

Position vector from the origin of the manipulator base frame to the center of mass of k-th 
body represented in the manipulator base frame. (m) 

Angular velocity of the k-th body in the inertia frame. (rad/s) 

Inertia matrix of the k-th body about its center of mass in the k-th body frame. ( kgm 2 ) 
Inertia matrix of the k-th body about its center of mass in the inertia frame, (kgm 2 ) 

Linear velocity of the center of mass and angular velocity of the vehicle in inertia frame, 
(m/s, rad/s) 

Joint variables (<71, • • • , </ n ) of the manipulator, (rad) 

Rotation matrix from the inertia frame to the manipulator base frame. 

Rotation matrix from the inertia frame to thek-th body frame (vehicle frame for k = 0, k-th 
link frame of the manipulator for k = 1 , * • • , n). 

Jacobian matrix of the position of the center of mass of k-th body (k = 1, • ■ ■ , n) in the 
manipulator base frame, (m) 
i x i identity matrix, 
z-y-x Euler angles. 
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2.2 Kinematics of Space Vehicle/Manipulator System 

The basic equations of kinematics of space vehicle/manipulator system is developed in this subsection. 
Fig. 1 shows a model of space vehicle/manipulator system. Five kinds of frames, the inertia frame, the vehicle 
frame, the manipulator base frame, the k-th link frames, and the manipulator endeffector frame, are represented 
by /, V, B, K, and E respectively. The link frames of the manipulator are defined by Denavit-Hartenberg 
convention [7]. The vehicle frame is assumed to be fixed at the center of mass of the vehicle. 

Supposing zero linear and angular momentum at initial time, the linear and angular momentum conser- 
vations are represented by 


2>*'n = o, (!) 

k—o 

£ (' + m* 'r* x 'r t ) = 0, (2) 

*= o 

The vehicle and manipulator motions are described by the following 0\ and 02- 



l r k is computed by 

/ r i = 7 r 0 + J u>o x ( r r k - 7 r 0 ) + ’AbJ %02 
= (Ej3 — 1 Role ) 0\ + ! Ab 02 

where 1 Ro k and ! Tok are defined by 


(5) 


On the other hand, is given by 


/ 0 

-'r 0 kz 

fr Oky \ 


I 1’0kt 

0 

-'rokx ] 

(6) 

X-^Qky 

1 rot* 

o J 



/ 7 r 0Jtr > 



II 

0 

U 

1 

-w 

K 

•**» 

‘roky 


(7) 


X^Okz / 



J uj k = 1 Aic 

k lk l Ak 

'wt 

(8) 




'(0 E)0 1 

H 'uo + ZU IA i (jj* 


for k — 0 
for k = 1 , • • , n 


(9) 


By substituting eqs. (5) and (8) into eqs. (1) and (2) and summarizing them in a matrix form, the linear and 
angular momentum conservations are represented by the following equation. 


H\01 + H202 — 0 
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(10) 



H 1 = 
£2=0 


-HUo^Rok 


. ££o m* 'ft £Lo 'Ab *i* ' A* T - ELo m k 'R k 1 Ro k 


(ii) 


where 


h 2 = 


Efc=0 m * 7 -^B *^2 

. ELo m * IR k 1 a b J% + p , 


! R, 


o 

r rkz 

- Ir k v 


- I r kl 


nfc 3 


/r iy 

X 

0 


(12) 


(13) 


P = (Pl P 2 P n ) 

p= (g'^vv) 


In eq. (13), / rjt JC , / rjk y and / r* :2 are x, y and z components of / l*fc respectively. 

The relationship between the endeffector, 6\ and 6 2 is described in the following form. 


where 


ft — J\Q\ 4- J2&2 




(14) 


(15) 


Ji and J 2 are the pure geometrical Jacobian matrices which do not take account of the momentum conserva- 
tions. In eq. (10), JFfi € R 6xS is always nonsingular. Therefore, eq. (10) is identical to 


e x = -Hr l H 2 e 2 


Substituting eq. (16) into eq. (15) offers 


h = (- j x Hr l H 2 + j 2 ) e 2 


(16) 


(17) 


Umetani and Yoshida [4] named the coefficient matrix of the above equation the generalized Jacobian 
matrix. In this derivation, the momentum conservations of eq. (10) are used as constraints equations and 
eliminated in the final equation. 


2.3 Holonomic and Nonholonomic Constraints 

Eq. (1) can be analytically integrated as follows: 


-t n n n 

/ y] Tn k I 'i’kdt = V' m* / r t (<) - Y' m * /r *(0) 

J ° k = 0 k= 0 k—0 


k= 0 

= 0 


(18) 


The above equation physically means that the total center of mass of the system does not move. I r k is 
computed by 
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7 r* = 1 A b B r k + 7 r 0 ( 19 ) 

where 1 A B is a function of the vehicle orientation only. B r k is a function of the joint variables of the 
manipulator only. Knowing the vehicle orientation, the joint variables, and the initial position of the total 
center of mass, the vehicle position I r t can be obtained by substituting eq. (19) into eq. (18). Therefore, the 
linear momentum conservation is considered a holonomic constraint because it is integrable. 

Although eqs. (1) and (2) are both represented by velocities, eq. (2) can not be analytically integrated and, 
therefore, it is a nonholonomic constraint. The physical characteristic of nonholonomic constraint is exhibited 
by the fact that even if the manipulator joints return to the initial joint variables after a sequence of motion, 
the vehicle orientation may not be the same as its initial value. The vehicle orientation can be eliminated 
as a dependent variable as we did in deriving eq. (17). In next section, we propose to control both of the 

independent and dependent variables by controlling the independent ones only. 

The basic system equation is obtained by taking the vehicle orientation and 0 2 as the state variable and 
the 0 2 as the input variable. First, the coefficient matrix of eq. (16) is divided into a top 3 x n matrix and a 
bottom 3 x n matrix as follows: 

h = (hI) =- h ~ 1h > (20) 

The state variable X and the input variable u are defined by 


X = 


/“\ 
0 

7 

\ 0 2 / 


G R 


in +3 


( 21 ) 


u = 02 G FT (22) 

a,0, and 7 are the z-y-x Euler angles of the vehicle with respect to the inertia frame. The relationship between 
the Euler angles and f Wo is given by 


where 


The system equation becomes 


where 


N = 


* 

II 

0 

3 

fa\ 

/ 

(23) 


KiJ 


0 — sina 

cosaccs/3 \ 


0 cosct 

1 0 

stna cos/9 1 
—sin/? / 


x = K u 

(24) 

N~'H 
E n j 

| e rt<"+ 3 > xn 

(25) 


2.4 Nonholonomic Redundancy 

The system represented by eq. (25) has a unique feature in the fact that the input variable may not be 
found even if a smooth desired trajectory of X is provided because it has less number of input variable. It is 
impossible to plan a feasible trajectory without taking full account of the dynamics of eq. (25). This is a general 
feature of nonholonomic mechanical systems. An automobile can move around in two dimensional space and 


185 



orient itself if we drive it properly, although it has only two variables to control, that is, wheel rotation and 
steering. In this case, the state variables are three and the inputs are two. 

By appropriately planning the trajectory, the desired final values of the vehicle orientation and the ma- 
nipulator joint variables could be reached. To locate the manipulator endeffector at a desired point with a 
desired orientation, even a vehicle with a 6 d.o.f. manipulator has redundancy because a variety of vehicle 
orientation can be chosen at the final time. The choice of the final vehicle orientation can be done based on the 
conventional control or planning schemes of kinematically redundant manipulators [8, 9, 10]. It is a problem 
to find an appropriate configuration among the configurations attained by 3 d.o.f. selfmotion. 

The nonholonomic redundancy would be utilized (1) when the extended Jacobian control results in an 
infeasible motion due to the physical joint limitation, (2) when the system requires more degrees of freedom 
to avoid obstacles at the final location of the endeffector, (3) when the vehicle orientation needs to be changed 
without using propulsion or a momentum gyro, and so on. 


3. PATH PLANNING USING LYAPUNOV FUNCTIONS 
3.1 First Lyapunov function 


In this section, the input variable U is synthesized based on the Lyapunov’s direct method [11] so that the 
vehicle orientation and the joint variables should converge to their desired values. 

The following function is chosen as a candidate of the Lyapunov function. 


tq = ^Ax t AAx (26) 

Ax = Xd-x (27) 

where A is a positive definite constant matrix, = 0 is attained only when X d = X. The time derivative of 
V\ is computed as follows: 


t>! = -A x T Ax = -Ax T AKu (28) 

where eq. (24) was substituted. Now, choosing the input variable as 

U 1 = (AK) T Ax, (29) 

the rate of change of the Lyapunov function becomes 

v l = — < 0 (30) 

If the equality of eq. (30) holds only when Xd = X, Lyapunov’s theorem [11] can conclude its global 

stability. However, eq. (30) is not the case. Vi becomes zero when Ax is in the null space of (AK) T , which 
is a three dimensional space. 


3.2 Avoiding Null Space of ( AK) T 


The LaSalle’s theorem [12] says that the state variable X converges to Xd if X = Xd is the unique entry 
of the maximum invariant set. When Ax is at the null space of ( AK) T and it stays within the null space 
thereafter, all the points on this trajectory are the entries of the maximum invariant set. In this subsection, 
the unit vector is chosen such that Ax should avoid the null space as much as possible and get out of the null 
space if it is there. 

To take account of the null space of ( AK ) we introduce the second Lyapunov function t >2 such that 


Ax T (/ - (AK) (AK)*) Ax 
V2 ~ A* T Aa; + €i 

where ei is a positive small constant. i >2 becomes equal to zero when Ax — 0. 


(31) 
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Since 


Ax T (l-(AK) (AK)*)ax 

=Ax t ( I - ( AK ) ( AK)*) T (/ - (AK) ( AK )*) Ax (32) 

= || ( J - {AK) (AK)*) Ax || 2 , 

the numerator of eq. (31) implies the squared Euclidean norm of the orthogonal projection of Ax on the null 
space of (AK) T . If we define <j> such that 


cos <f> = 


II (l-(AK)(AKf)Ax\\ 

II Ax II 


0<*<5 


(33) 


<t> means an angle between Ax and the hyperplane of the null space of (AKf , and can be considered as a 
distance of Ax from the null space as shown in Fig. 2. For ci = 0 the second Lyapunov function becomes 


t >2 = cos 2 <f> 0 < <(> < —■ (34) 

In eq. (31), fi allows for t> 2 not to take extreme values and to be defined at Ax. In eq. (34) v 2 is monotonously 
reduced as <j> grows, and takes zero at <f> = x/2, which means the farthest point from the null space. 

Taking the derivative of v 2 with respect to time, we have 


If we choose U 2 such as 


dv 2 . dv 2 



and use it as U, then t> 2 < 0, and 1i 2 works to avoid the null space by driving toward <f> = x/2. 
We integrate tii and U 2 in a hierarchical manner such that 


(35) 


(36) 


u = kiU t + k 2 (I - UiV.!*) u 2 (37) 

where U x * is the pseudoinverse of t*i, Jfci and Jfc 2 are positive constants. Since (I - UiUi*) tt 2 is the orthogonal 
projection of U 2 onto the hyperplane that is perpendicular to l*i, the first and second terms are mutually 
perpendicular. This results in following properties of eq. (37). 

The second term of eq.(37) has no effect on the convergence speed of tq f because substituting eq. (37) 
into eq. (28) we have 

vi = -Ui T {u x + *i (J - UiU*) U 2 ] = -t li T Ui (38) 


T 

where «i T (/- = («i - «iMi # Ui) = 0 is used. 

Let’s consider the effect of the second term of t> 2 . Substituting the second term of eq. (37) into eq. (35) 
along with eq. (36), we obtain 

*»- -t£* v- ^ KT (w)' t w 

= Jjl K (I- u ,u,') r (I - «,«,*) K T (^y<0 

t Xhe convergence speed tq is the same for both Ui and ti of eq. (37) only in local sense. Since the global 
trajectory of X varies depending on the choice of the input, the global convergence speed would be different. 
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i )2 becomes zero only when (/ — U\U\ *) K T (dv 2 /dx) T = 0. Otherwise v 2 is always negative. This means 
that the second term of eq. (37) tries to reduce v 2 although the total U of eq. (37) does not be guarantee the 
negativeness of v 2 because of the effect of the first term. 

To summarize eqs. (28),(29),(35),and (36), the proposed hierarchical Lyapunov function approach can be 
represented as follows 


U = ki U\ + k 2 (I - tiiUi # ) U 2 


(40) 


u; = -K T 



for i — 1,2 


(41) 


It should be noted that if we consider t;* as the ith manipulation variable, ( dvi/dx)K as its Jacobian 
matrix with respect to the input variable U, then eq. (40) is identical to the task-priority approach developed 
for kinematically redundant manipulators[10], having 


i ' = -H** T 0l) T . for t = l , 2 (42) 

as the desired trajectories of the manipulation variables. This approach cannot guarantee that X — x d is the 
unique entry of the maximum invariant set [12] and, therefore, the trajectory may halt at some point in the null 

space of ( AK ) . However, if the second Lyapunov function can successfully avoid the null space of (AK) T t 
X converges to X&. 


4. CONCLUSION 

A new insight of the mechanical structure of space vehicle/ manipulator systems was given. By utilizing 
the nonholonomic structure, not only the manipulator joints, but also vehicle orientation can be controlled 
only by actuating the joint variables, although both of the vehicle motion and the manipulator joints cannot be 
controlled independently. Therefore, it is essential to plan a feasible trajectory. A nonlinear control scheme was 
synthesized using Lyapunov’s direct method. This scheme can be used not only for real-time control, but for 
planning of a feasible motions of vehicle and manipulator. To verify the effectiveness of the proposed approach, 
numerical simulation is currently being undertaken at the Center for Robotic Systems in Microelectronics, 
University of California, Santa Barbara. 
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Fig 1. Five Coordinate Frames for the Space 
Vehicle / Manipulator System. 


189 



{I-(AKXAK) )AX 


T 



T T 

n {(AK) } : t* 1 ® null space of (AK) 

JL T T 

n {(AK) } : the orthogonal complement space of n {(AK) ) 


Fig 2. Physical Meaning of the 2nd Lyapunov 
Function and Definition of Angle <p . 


190 


